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Abstract 

Recently there, has been considerable interest in efficient formulations of manipulator dynamics, mostly 
due to the desirability of real-time control or analysis of physical devices using modest computers. The 
inefficiency of the classical F.agrangiun formulation is well known, and this has led researchers to seek al- 
ternative methods. Several authors have developed a highly efficient formulation of manipulator dynamics 
based on the Newton buier equations, and there may be some confusion as to the source of this efficiency. 
This paper shows that there is in fact no fundamental difference in computational efficiency between 
Lagrangian and Ncwlon-F-ulcr formulations. The efficiency of the above-mentioned Ncwton-'buRr for- 
mulation is due to two factors: the recursive structure of die computation and the representation chosen 
for the rotational dynamics. Both of these factors can be achieved in the Lugrangian formulation, resulting 
in an algorithm identical to the Newton-Fuler formulation. Recursive l.agrangian dynamics lias' been dis- 
cussed previously by Hollerbach. This paper takes the final step by comparing in detail the representations 
that have been used for rotational dynamics and showing that with a proper choice of representation the 
Lagrangian formulation is indeed equivalent to die Newton daiier formulation. 
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1- Background 



Manipulator dynamics concerns the relationship between the motion of a mechanical kinematic chain of 
linkages and the forces applied by its actuators. For some problems, such as simulation, the forces are 
known and it is desired to compute the resulting motion. Tn other cases, such as the important area of 
real-time control, the desired motion is known and the forces necessary to achieve that motion must be 
computed. In either case, for a given model of a kinematic chain an exact solution can be found, within 
the framework of Newtonian mechanics. The former case reduces to a system of non-linear second order 
differential equations, which can be solved numerically. The latter case is easier— the required forces can 
be expressed directly in terms of the known position, velocity and acceleration of the chain. 

/""^ fii this paper we restrict the discussion to open-loop kinematic chains, composed of rigid links con- 

nected by joints that allow relative motion of the links. We assume that each joint has only one degree 
of freedom, either rotational or translation^. Multiple rotational degrees of freedom can be modelled by 
links of zero mass and length. 



LI Lagrangian Generalized Coordinates 

Tn Newton's original formulation of mechanics, the relationship between forces acting on bodies and 
the resulting accelerations is described using cartesian coordinate systems. There are other, equivalent 
ways to describe the dynamics of a system of bodies. One such method was invented by Lagrange, using 
what are known as generalized coordinates. Generalized coordinates are any convenient set of variables 
that completely define the position of a system of bodies. The Lagrange equation 
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describes the relationship between die corresponding generalized forces acting on the bodies and the 
kinetic and potential energy of the system. Here q L is a generalized coordinate, r t is the corresponding 
generalized force, and the dot indicates differentiation with respect to time. L is the I.agrangian— the 
difference between the total kinetic energy and the total potential energy of the system: L = K — P. 

While the Lagrange equation must yield the same numerical results as direct application of Newton's 
laws, either approach may be more convenient than the other in a given situation, or may provide greater 
insight into the physics of the problem. 

1.2 The Uicker/Kahn Formulation 

A kinematic chain has a natural set of coordinates that completely specify its position— the joint 
variables q { (angles for rotational joints and distances for sliding joints). The q t satisfy the requirements 
for generalized coordinates. Furthermore, they can be measured directly by the manipulator and the 
corresponding generalized forces (torques for rotational joints and ordinary force for sliding joints) are 
just what can be controlled. It is not surprising, then, that die pioneering work of Dicker [1] and Kahn [2] 
on the dynamics of mechanical linkages made use of the Lagrangian method. 

From the standpoint of the present discussion, the important feature of die work of Uicker and 
Kahn is their use of 4 X 4 rotation/translation matricies W. L to represent the position and motion of the 
kinematic chain. A coordinate system is attached to and moves with each link. The matrix W, t transforms 
die components of a vector with respect to link i coordinates to its components with respect to a fixed 
(inertial) coordinate system. The position and motion of the chain is described by the W { 9 s and their time 
derivatives, which are in turn functions of the %'s and their time derivatives. 

Once die kinetic and potential energy of the chain is expressed in terms of the Wi's and their deriva- 
tives, it is a straightforward matter to apply the Lagrange equation and find the generalized forces. The 
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result looks like 

<9$ 



^X>(^ W iT (1-2) 



where T; is the generalized force applied to the zth joint, J} is the 4x4 inertia matrix of the jth link in 
that link's coordinates, and tr is the trace operation, The gravity term is omitted here because it is not 
important for this paper, although in general it must of course be included. 

It has been observed by many authors that evaluating (1.2) directly as written requires time propor- 
tional to the fourth power of the number of links. Ilollcrbach [3] has determined that for 6 links well over 
100,000 adds and multiplies would be needed to compute all of the r/s, and Luh et al. [4] report that 
a Fortran program running on a PDP-11/45 took nearly 8 seconds to compute them. Since a real-time 
control system would have to repeat this calculation at a rate on die order of 60 Hz, until recently it had 
been believed that a manipulator could not be controlled by direct real-time calculation of the actuator 
forces, without introducing approximations or using lookup tables. 

The inefficiency of the original Uicker/Kahn formulation, as well as other reasons, have led research- 
ers to look for alternative formulations of manipulator dynamics. The most successful of these has been 
the Newton-Euler approach. 

1.3 The Newton-Euler Approach 

In order to apply Newton's laws to objects which are not point masses, we consider such objects to 
be composed of a large number of point masses bound together by effectively infinite internal forces. The 
laws governing these so-called "rigid bodies" may be derived from Newtonian mechanics [5]. The key 
feature is that the description of motion is broken up into two independent components— linear motion 
of the center of mass (or other suitable point) and rotation of the body about that point. The total vector 
force acting on the body is related to die acceleration of die center of mass by Newton's second law: 
F — mv. The total vector moment (torque) about die center of mass is related to die angular velocity and 
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angular acceleration of the body by Ruler's equation 

N = /-ti + w x (£•«). (1.3) 

The Fulcr equation follows directly from the laws of rotating reference frames and the following 

definitions: 

uj angular velocity 

J inertia tensor 

angular momentum 

moment (torque). 

These definitions are analogous to those found in the case of linear motion, except that inertia is a second 
rank tensor instead of a scalar, since angular momentum is not in general parallel to angular velocity. If we 
use d*jdt to indicate differentiation with respect to the rotating reference frame, we then have: 

dL d*L , 

— J • u) + to X (J - u)). 

To apply the Newton-Fiiler equations to a kinematic chain, the following procedure may be used. 

1. The base of the chain is either fixed or its motion is known. Starting from the base and working 
outwards, and using the known geometry of the chain, v^ uji, and uj( of link i may be found in 
terms of the <£, cjj, and ijj of the prccccding joints. 

2. The total vector force Fj and the total vector moment N{ acting on each link may now be 
determined using the Ncwton/Euler equations. 

3. The total force computed in step 2 is the vector sum of the forces exerted on the link by its 
neighbors at the joints, and the force of gravity. The total moment is the vector sum of the pure 
moments exerted on the link by its neighbors, and the moments generated by the forces exerted 
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by its neighbors. Thus if the force and moment acting at one end of a link are known, we can 
use the totals from step 2 and the known force of gravity to solve for the force and moment 
acting at the other end. These are equal and opposite to the force and moment exerted by the 
given link on its neighbor, by Newton's third law. Thus, if the force and moment exerted by the 
environment on the terminal link (e.g. the hand) arc known, we can proceed down the chain to 
the base and determine the force and moment acting at each joint. 

4. For rotational joints, die vector moment determined in step 3 is projected along the axis of 

rotation to yield the joint torque. For sliding joints, the vector force from step 3 is projected 

along the sliding axis to yield the joint force. The other components of the force and moment 

arc generated by the structure and bearings of the device. 

It is clear that many details must be filled in before the above procedure can actually be applied to a 

kinematic chain. We must have conventions for defining the geometry of the chain and specifying how the 

joint variables are to be measured, and coordinate systems that allow the vector and tensor quantities to 

be specified. The transformation required by step 1 must be worked out, and the operations specified by 

the other steps must be written down in detail. The efficiency of the resulting computation will depend on 

how these issues are resolved. 

Recently a number of authors have been interested in the Ncwton-Euler approach, partly due to 
perceived problems with the Lagrangian formulation, as mentioned above. Stepancnko and Vukobratovic 
[6] worked out the details in connection with work on understanding the dynamics of human limbs. One 
of their main goals was to develop a computer program that could perform the tedious mathematical 
manipulations necessary to set up the equations of motion from a description of the kinematic chain. 
They rejected the Lagrange equation because of the differentiations it requires— there are severe problems 
associated with numerical differentiation, as they pointed out. These problems can be avoided, however, 
by deriving the differential equation of motion for an arbitrary kinematic chain, as is done in section 3 
for the open-loop class. Numerical values for a specific device are then substituted, but at this point all of 
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the necessary differentiations have been done symbolically. The general solution can readily be found by 
hand, and only needs to be done once. 

Stepanenko and Vukobratovic were not concerned with the efficiency of the computation. Their 
formulation was revised by Orin el ah [7] in connection with the control of robot legs. They improved 
upon the efficiency of Stepanenko and Vukobratovic by referring the forces and moments to coordinate 
systems attached to die links instead of fixed coordinates. They also noticed that the sequential nature 
of the computation (iterating from the base to the tip to determine the motion of the chain, and then 
from the tip to the base to determine the forces, as described above) seemed to reduce the computation 
time and storage requirements. They speculated that such a recursive procedure might be more efficient 
in general, but did not draw any conclusions. Armstrong [8] and Luh et al. [4] paid close attention to com- 
putational efficiency and confirmed these suspicions. They pointed out that the Newton-Ruler formulation 
leads to an algorithm where the computation time grows linearly with the number of links, as opposed 
to the quartic behaviour of the original Lagrangian formulation. They further improved the efficiency by 
referring the linear and angular velocities and accelerations, as well as die forces and moments, to link 
coordinates. In addition, the need for efficiency produced a formulation which is simpler in many ways. 
For example, the three coordinate systems attached to each link by Stepanenko and Vukobratovic were 
replaced by one. 

1.4 Recursive Lagrangian Dynamics 

Hollerbach [3] realized that the recursive nature of die Ncwton-Euler formulation that made it so 
efficient could be achieved with the Lagrangian formulation as well. Starting with the original results of 
Uicker and Kahn, he developed forward and backward recurrence relations for the terms in (1.2) that al- 
low die generalized forces to be computed in linear time. The result for a 6-link manipulator still required 
about 5 times die number of adds and multiplies as the Luh formulation, but this is about 15 times better 
than direct evaluation of (1.2). 
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Hollcrbach also realized that the use of 4 X 4 rotation/translation matricics to represent the position 
and motion of the chain led to inefficiencies in the calculation. He reformulated the Lagrangian dynamics 
in terms of pure rotation matricics to specify the orientation of the links, and displacement vectors to 
specify their position. This reformulation resulted in an additional factor of 2 savings in adds and mul- 
tiplies, bringing the Lagrangian formulation to within roughly a factor of 2^ of Luh's Newton-Euler 
formulation. 

1.5 The Importance of the Representation of Angular Velocity 

Hollcrbach used a rotation matrix W{ to specify the orientation of link i of the kinematic chain. W{ 
transforms the components of a vector with respect to a coordinate system fixed in link i to its components 
with respect to a fixed (inertial) coordinate system. The angular motion of link i is represented by the time 
derivatives of Wf. W{ and W{. 

Although W{ t W{, and Wi each have nine components, orientation has only three degrees of 
freedom and thus only three of die components are independent. An equivalent representation for the 
angular motion of a link is the angular velocity vector io t and the angular acceleration vector u) i9 which 
have been used in all of the Newton-Eulcr formulations reported here, and which contain no redundant 
information. Unfortunately, diere in no "orientation vector" corresponding to W t \ the Euler angles or 
equivalent may be used instead, although we will not need to do so here. 

In the next section we explore in detail the relationship between to and W, and the resulting descrip- 
tions of rotational dynamics. In the following section we show that a Lagrangian formulation based on 
u) instead of W leads to exactly the same computation as die Newton-Euler formulation. This result is 
hardly surprising, since both methods must give the same numerical solution, and we are now starting 
with exactly the same quantities. The significance of this result is not just that it doesn't matter which 
formulation one uses. Rather, it shows what the real issues are if one is interested in efficiency: structure of 
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the computation and choice of representation. 
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2. Comparison of Rotational Dynamics with w and W 



It was pointed out above that the angular motion of a rigid body could be described equally well by cither 
the angular velocity vectors or the derivative of a rotation matrix, W. Obviously, scalar quantities such as 
kinetic energy must be independent of the representation chosen, but higher rank tensor quantities need 
not be, and expressions for any quantity will be different in form. Furthermore, neither representation is 
dearly better in all cases. Use of a; may yield a more efficient computation, but it has the disadvantage that 
there is no "angular position vector" that it is the derivative of. Therefore, it is interesting and useful to 
compare the description of rotational dynamics that results from different choices of representation, and 
to develop formulas that allow one to switch between representations. That is the main purpose of this 
section, although in making this comparison we will also get expressions for rotational inertia and kinetic 
energy which are needed in the next section. 

21 W 

We start by defining W more formally and introducing some conventions that are needed below. 
We assume that die reader is familiar with the properties of the angular velocity vector to and rotating 
reference frames, which have been discussed in many texts (see, for example, [5]). 

Let {ci, e 2) e 3 } be any fixed (incrtial) orthonormal basis, and let {e\ } e f 2) ef 3 } be any orthonormal basis 
attached to a rotating rigid body. We will always use primes to indicate rotating basis vectors or the 
components of a vector with respect to such a basis. Thus, if v is any vector we have: 
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From now on we will drop the summation sign and use the Einstein summation convention, that is, 
indices that appear twice in any term imply a summation of that term over all values of the indices (i.e. 
{1,2,3}). 

Using the above conventions we can write: 



v = v'/j 






A A A, , 






v h = Wiji/j, 


w l3 


A A/ 


dW tj 
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(2.1) 



Note also that since the inverse of W is its transpose, we have: 

W ik \Vl j =Wi k W jk = Si jt (2.2) 

where 6{j are the components of the identity tensor £. 

2.2 The Cross Product Operation 

We must now briefly discuss the cross-product operation, which is indispensible when dealing with 
rotation in three dimensions, and which must be used unambiguously with second rank tensors as well as 
vectors. We assume that the standard geometric definition of the cross product of two vectors is known to 
the reader. 

The cross product may be viewed as a function of two vectors that produces a third vector: 

Alternatively, we may view the cross product as a function of three vectors that produces a scalar, the so- 
called scalar triple product: 

ft X b • c = s = P(a, 6, c). 
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The function Pis: 

• Linear in a, b, and c. 

• Independent of the choice of basis vectors (since it is defined geometrically). 

Therefore, P is a rank three tensor 1 . 

To find the components of P according to some right-handed basis {e [} e 2} e 3 }, we simply apply the 
function to the basis vectors: 

AAA 

— 6( X 6j ' 6k 

(1, if ijk is an even permutation of 123, 

— 1, if ijk is an odd permutation of 123, 
0, otherwise. 

From this it can be seen that P is totally anti-symmetric— swapping any two indices changes the sign (but 
rotating the indices has no effect). To illustrate how P is used, here are the formulas for the cross-product 
of two vectors, and the scalar triple product, in coordinates: 

Is X b\i = Pijk^jhk a • b X c — Pijkaib :j c k . 

There are two very useful identities associated with the components of P: 

PijkPiji — 2<5fc/, (2.3) 

and 

PijkPilm — SjiSkm — Sj m Skh (2.4) 
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Technically, a pseudotensor, since it requires consistent use of right- or left-handed coordinate systems, but not both. 
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2.3 The Relationship Between a> and W 

We can now find the explicit relationship between to and W. That relationship will be seen to be 
position (i.e. orientation) dependent, and the position will always be represented by the rotation matrix 
W. 

Let v be any vector rotating with angular velocity uj. We can derive die components of £ in the 

following two ways: 

1) v= u) X v 2) Vi= W^. 

Equating the two gives: 
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W lj V f J = P ikl UJ k Vi = PiklLOkWijV'j. 

Since this must hold for any v, it is clear that 

W ij = P m uj k W lj (2.5) 

(or in vector notation, W = uj X W). The inverse relation may be found from this and equations (2.2) 

and (2.3) as follows: 

Wij = Piki^kWij 

WmjWij = PikiW k 8 lrn = PikmWk 
PinmWmjWij — PikmPinm^k = 24rMc = %W n . 

Making an appropriate change of dummy indices, we get 

Wi = fcjkWjtWu, (2.6) 

to which there is no corresponding vector notation known to the author. 

2.4 Rotational Inertia and Kinetic Energy 

This section has three purposes: it gives one example of how a dynamic quantity (rotational kinetic 
energy) can be expressed in terms of either uj or W, it provides one way of defining the inertia tensor (the 
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definition will depend on whether u or W is used), and it provides the expression for rotational kinetic 
energy that is needed for the Lagrangian formulation of the next section. 

Let r be a vector from the center of mass of a rigid body to a small volume clement of mass dm. The 
velocity and kinetic energy of the volume element (due to rotation of the body) can be written as: 



v = r 



dK = ^v - vdm. 



We will express dK in terms of both W and lo and integrate over the body to get the total rotational 
kinetic energy. The definitions of the inertia tensor will fall out of the derivation. Components of vectors 
f *^ are with respect to any right-handed orthonormal basis, primed for rotating and unprimed for fixed, as 

above. First, using W: 






dK = ttW ij r' j )(W ik r' k )dm 
K = l 2 W i3 W tk J v r'/ k dm 



1Ct ^ , v 



f v r'/ k dm (2.7) 

K=^W ij J' jk W ik 
' = ±tr{WJ'W T ). (2.8) 



r\ 



The last expression is in matrix form for the benifit of readers who are more familiar with that notation. 
Now we repeat the derivation, using lo instead: 
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dK = £(w Xr)'(wX r)dm 



h Ife • ^)fe * t) — fe ' r)fe ' x)\ dm 



= ^[cu/u^^r 2 — WiWjr/rJdm 

= ^u) l LO J (r 2 5 ij — r^dm 

K = ^ujitoj / (r 2 Sij — riTjjdm 
j v 

let kj = / (r 2 % — Tir/jdm 
Jv 

K = ^LOiiUjIij = ^u; • / • oi. 
From equations (2.7) and (2.9) the relationship between the two inertia tensors can be seen: 



(2.9) 
(2.10) 



l=tr(J)6 — J, 



J = iir(/)|-X. 



(2.11) 



Note that since £ and J have been defined above by their components, they have not actually been shown 
to be tensors. The proof is simple and can be supplied by the reader. 

From equations (2.8) and (2.10), and a definition of a generalized coordinate q, the rotational con- 
tribution to the corresponding generalized force can be found from the Lagrange equation. This was 
done by Hollcrbach [3] for W 9 and is done in the next section for y. We summarize the results here for 
comparison: 



angular 
velocity 


a; 


W 


kinetic 
energy 


^U) • J • U) 


l 2 tr{WJW T ) 


generalized 
force 


\u>'l + ui X (l'w)]~ 


KM 



While these expressions have been derived independently, their equality can be verified by direct substitu- 
tion using equations (2.4), (2.5), (2.6), and (2. 1 1). 
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3. Lagrangian Dynamics Using to Instead of W 



In this section wc give the details of the Lagrangian formulation based on the angular velocity vector u>. 
The generalized forces are derived for any open-loop kinematic chain, and the results are interpreted and 
compared to the Newton-Euler formulation of Luh [4], 

One feature that distinguishes the present formulation from previous ones is that expressions for the 
generalized forces arc derived without defining a single coordinate system. All quantities are expressed in 
terms of geometric objects (tensors) and geometric operations (vector addition, dot and cross product). It 
is only at the end, when a computation must be derived from these expressions, that coordinate systems 
must be defined, so that the various quantities can be measured and represented in a computer program. 
^**s At tli is point, expressions may be evaluated in any convenient right-handed orthonormal coordinate sys- 

tem, provided that this is done so in a consistent manner. In practice, the method presented by Luh [4] is 
probably most efficient. 

3.1 The Derivation of the Generalized Forces 

In this section we write down the total kinetic energy of a kinematic chain and apply the Lagrange 
equation to derive the generalized forces. The potential energy term due to gravity is omitted here as 
mentioned in section 1.2, although this and other minor details are taken care of below. 

The total kinetic energy of a rigid body is the sum of the energy due to the motion of the center of 
mass and the energy due to rotation about the center of mass [5]: 
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To get the total energy of a chain, sum over all of the links: 
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2=^1 



2 m ife) 2 + 2^i 'Li W t 



(3.1) 



Wc may now compute the derivatives required by the Lagrange equation (1.1). 



dK 
dqj 



E 



dv t dun 

d qj ~ dqj 



(3.2) 



r^. 



The first term of (3.2) follows directly from the chain rule. For the second term, note that while the 
inertia tensor/, is a function of position, it is independent of any joint velocity qj. Furthermore, since/ is 
symmetric, 

dqj ~ ~ dqj- 



Straightforward application of the rules for differentiating products gives: 



didK_ 
dtYdqj 



E 



dvi , d ( dvi \ 

dqj dt\3qj J 

~ dqj ~ c% ~ dt\dqj 



(3.3) 



It is shown in Appendix A that: 



d I dvi \ 

dt\dtj) 

LOi ■ /,■ • ~- 
~ <% 

d IdwA 

dl[d qj ) 



«t • Xi 



Wi X 



dqj 



dqj 

-5- + <A% x -r- 

it \ dw% 

— <&i X Hi ■ w,-J • 5r- 



(3.4) 
(3.5) 
(3.6) 

(3.7) 
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Substituting (3.4)-(3.7) into (3.3) gives: 






™<iVi • — + nriiVi • — - + m • Xi • -xr- 



■KrXf 



<9o; 2 - 



(3.8) 



Now for the final term in the Lagrange equation: 



dK_ 
dqj 



i 



dv 



®£i 



™>iVi • ~ — I- Hi • Xi • ^r" + m 



dqj 



dqj 



2^^ 



dq 3 



w. 



(3.9) 



This is very similar to (3.2), except for the appcarence of a term due to the position dependence of the 
inertia tensor. It is shown in Appendix A that: 

dli 



dqj ~ d qj 



Putting it all together: 



d_(df£ 

dt\ dqj 



dK 

dqj 



— X] ( mi ^ ' ^- + & { ' b + ~ i ' x (£» ' ~ i 'M ' ^ ) 



(3.10) 



(3.11) 
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3.2 Comparison with the Newton-Euler Formulation 

We have derived the generalized forces in a very general way, without unnecessary details like 
coordinate systems, link and joint numbering conventions, and other conventions needed to specify the 
geometry of the manipulator. In order to interpret the result and compare it to the Newton-Euler formula- 
tion, however, it is finally necessary to make some of these definitions. Such details are not the point of 
this paper, and will be kept to a minimum. 

The links of the manipulator are numbered consecutively from the base to the tip, as are the joints 
that connect them. The base is considered to be link 0, while the terminal link is numbered link n. The 
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i ^*s. 




Figure 3.1. Link and joint numbering, and other conventions for open-loop kinematic chains. 



joints arc numbered 1 thai n, joint 1 connecting link 1 to the base. Thus joint i connects links i — 1 and 
i\ link { is bounded by joints i and i + 1, as shown in figure 3.1. 

If joint i is rotational, the joint variable q t measures the angle of rotation from some (arbitrary for the 
present discussion) reference point; if it is translational, q- h measures the sliding distance. The unit vector 
%i is attached to joint i and points along the axis of rotation for rotary joints or along the sliding axis for 
sliding joints. Note that for rotary joints, qt must be measured in a right-hand sense about Z{. Finally, let 
Pj t i be a position vector that points from anywhere along the axis of joint ; to the center of mass of link 
i. (Note: These definitions of 2; andp^ arc non-standard, and arc clearly too ambiguous to be used in 
practice. They are, however, all that is needed to understand equation (3.11)). 

One of the first things one notices when looking at equation (3.11) is that it contains the Newton- 
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Euler expressions for the total vector force and moment acting on a rigid body. In fact we can rewrite 
(3.11) as: 

Thus we are very interested in the vectors <%/(% and Sua /dqj that the force F( and moment TV,- are 
projected onto. These vectors specify the dependence of the linear and angular velocity of link i on the 
joint velocity of joint j. For j > { there is no such dependence, and so these vectors are 0. This means 
that the summation in equation (3.12) can be taken from i = j to i = n, instead of over all i. 

For j < i, we note that the linear and angular motion of link i may be written as the vector sum of 
contributions due to the relative motion of the previous links at the joints: 

* j {qjZj) X pj t u if joint j is rotational; 
j^=i \qjZj, if joint j is iranslational. 



v^ I hfiu if joint y is rotational; 
««-=Ei (3-14) 

i^ 1 ifi. it joint j is translational. 



Differentiating gives: 



dv- \ z 3 x Pj,i> if joint j is rotational; 



^ I Zj, if joint j is translational. 



zj y if joint y is rotational; 



(3.15) 




0, if joint j is translational. 
If joint y is translational, the joint force can now be written: 






(3.16) 
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If joint j is rotary, the torque is: 



*j = h ■ D&-,i x Ei + N t ). 



i=3 



Thus, to compute the generalized forces we first iterate from the base to the tip to compute V{, wu andcii, 
and then iterate from the tip to the base using the above relations to compute the forces. Referring to [4], it 
can be seen that this is exactly the computation specified by Lull that was derived from the Ncwton-Euler 
approach. 

A few minor points still need to be cleared up, however. First, we arc still free to choose a coordinate 

system or systems in which to evaluate these expressions. The method presented in [4] is probably best, 

where quantities associated with a given link (such as die inertia tensor) are expressed in a coordinate 

f^- system attached to that link, and then arc transformed to the coordinates of the previous link as the 

iteration proceeds. 

Second, we must say something about the gravity term which we have thus far ignored. We could 
include it in the Lagrange equation in the standard way, as a position dependent potential energy term. 
This is equivalent to its inclusion in the Newton-Euler formulation as described in step 3 of section 1.3. 
Perhaps a better way was also discussed by Luh — instead of considering the base as fixed, give it a vector 
acceleration equal to that due to gravity. Roth methods will give the same numerical result, but Lull's is 
probably more efficient since the effect of gravity is computed only once. 

Third is the sliding friction forces produced in the joints that Lull includes in his equations. These, 
however, are simply computed based on the joint velocity and are added directly to the joint generalized 
force. This clearly can be done no matter how the dynamics are formulated. 

Finally, the Newton-Euler dynamics includes the solution to the problem of the statics of the 
manipulator, that is the effect of the external force and moment acting on the terminal link. This can 
be included in the Lagrangian formulation by supposing an additional link attached to the terminal link, 
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whose motion is defined so as to produce die required external forces. This is very much like including 
gravity by specifying the acceleration of the base rather than the equivalent forces. 



j^N 
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A. Details for the Lagrangian Formulation 



In this Appendix wc supply the details that were omitted from the derivation of the generalized forces 
presented in section 2.1. 

For equation (3.4), let & be a position vector from any fixed origin to the center of mass of link {, so 
that Vj = Tji. Then we. have: 

<% <% dq 3 ^dq k qk dq 3 - [AA} 



dt[dqj) dt{d qj ) - ^dqfiq k qk ~ dq 3 ^ dq^ 
/"""v d . dvi 



Equation (3.5): 



Equation (3.7): 



<Ai ■ Li ■ ^r- = Ui ■ fei X li —li X u>i) ■ ~ 

~ dqj ~ ~ % 

~ dqj ~ dqj 

= <Hi XiOi-li- -t («,• • li X U)i ■ -^ 

~ dqj -' dqj 

dqj 



"i ■ li ■ «i X ^ ) = (ua -li) XUi'-r 1 

= — «.• X (Li • w 8 ) • -=*. 
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For equation (3.10): Following a procedure similar to that used in (A.l) above, it can be shown that: 

dqj ~ dq/ 

Thus we have: 

d qj dqj ~ ~ 

dqj ~ ~ dqj 
Therefore, 

= i«i • ^r- X ib • tot) - \{MH<U) X-^'Ui 
oqj aqj 

oq 3 ~ oqj 

fr ^ du){ 

= —<£{ x Hi -in)' t~-. 

The final (and trickiest) proof is equation (3.6): 

dt\dqj J dqj ~ l dqj' 

We will need equations (3.14) and (3.16), and die conventions of section 3.2 (see figure 3.1), except that for 
convenience we will take z k to be if joint k is translational. 

First note that if joint j is translational, or if j > t, uj { is independent of both qj and q J9 so that both 

sides of the equation are identically zero. Now for j < i, since Zj is attached to joint j and therefore link 

y, we may write: 

d ( duji \ dzj A 

By considering the rotation of a vector by some angle about a given axis, it can be seen that: 

||=4x2, (j<k). (A3) 
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Now we have everything we need for the proof. Starting with (A.2), 



/*""% 



d ($& \ w A 

dt\dqj 



I o~- I = Uj X Zj 



fe* - LI ^fc) X zj 



«i x ^ + 2^ qhZ J x ^ fc 



A . \ — ^ . OZU 



. . A (9 V— > . A 

«« x 2 j + ^ Zw **** 

(9a;,- , du); 
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